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1J Introdncttop. 

Xfiii f pi i iipmti research on control, design and programming of kinematically redundant robot manipulators 
(KRRM)/ These are device* in which there are more joint space degrees of freedom than are required to achieve every posi- 
tion and orientation of the end-effector necessary for a given task in a given workspace. The technological developments 
described id thispaper deal with: 

. 4 . ..Kinematic programming techniques for automatically generating joint-space trajectories to execute prescribed tasks; 

A» Control of redundant manipulators to optimize dynamic criteria (c.g., applications of forces and moments at the end- 
effector that optimally distribute the loading of actuators); - ^ 
fk .Design of KRRMs to op timize functionality in congested work environments cr to achieve other goals unattainable 
with non-redundant manipulators. ^ , , A , 

Wo rlisnuri kinematic programming techniques/shsadng that some pseudo-inverse techniques that have been proposed 
for redundant manipulator control fail to achieve the goals of avoiding kinematic singularities and also generating closed 
joint-space paths corresponding to close paths of the end effector in the workspace. The extended Jacobian is proposed as an 
alternative to pseudo-inverse techniques. It incorporates functional constraints in a straightforward way to resolve redun- 
dancy, and can meet a variety of spatially-varying optimality criteria. This method can generate manipulator trajectories that 
automatically avoid obstacles provided suitable distance functions are defined, and if the intersections of the constraint sur- 
faces are characterized in a sufficiently simple way. 

2 .0 Design lanes 

A six degree-of-freedom geometry canno longer be considered a general purpose manipulator. This geometry has fatal 
kinematic flaws that arise from singularities and restrictions on the workspace. The major flaw of six degree-of-freedom 
manipulators is the presence of singularities in thninterior of the workspace. It is exceedingly difficult to plan trajectories 
that do not pass through or near singularities, grventhc complex transformation between end effector locations and joint 
angles. An extra degree of freedom makes functional interior workspace points in the sense that a nonlinear configuration 
can be found that will corr e spond to a given workspace point. Singular configurations will still arise, but they can be avoided 
through exercise of a self-motion to arrive at a new configuration^ i self-motion is created by a redundancy and is defined 
as an internal motion of the linkage that does not move the endpointNJTie trajectory planner must still be wary of interior 
singularities, but upon arriving at one, the motion can backtrack so as to'evotvc to a different configuration at the singular 
point. Thus a seven degree-of-freedom re pr es ents a minimal configuration (feast complex geometry) that makes available all 
interior workspace points. \ 

Seven degree-of-freedom geometries are complex and costly. Most industry Efforts have therefore focused cm seeking 
methods to mitigate the effects of singularities. Strict realization of the velocity requirements at the endpoint must be aban- 
doned. Sometimes a self-motion at the singularity can be used to find an alternative configuration for which the possible end- 
point velocities happen to coincide with the desired one [1], although the manipulator mus^ffectively come to a stop for this 
self-motion to occur. 

3.0 Resofatkxi of Redundancy \ 

Redun dan cy resolution schemes fall into two broad categories: local optimization or global Optimization techniques. 
Within each category, the optimization may be done at the kinematic or at the dynamic level. 
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Mo«t research has involved the instantaneous or local resolution cl the redundancy through use of the pseudo-inven 
These local techniques deal with the instantaneous kinematics of motion, U. % motion which is locally optimized by increme 
tal movement from the current arm state. 

Global optimization minimizes some performance index across a whole trajectory, and hence should perform ben 
than local optimization. Yet the complexity of problem formulation and the computational intcractibility have restricted tl 
m* of global optimization schemes for redundant manipulators. 

The advantages of the local optimization methods over global methods are twofold: the simplicity of problem formul 
tion and the relatively small amount of computation required for the algorithm. The small amount of computation assodati 
with local methods offers the possibility of real-time control of the manipulators. The local technique, however, may s 
always be desirable for controlling redundant arms. [2] showed motions of a redundant manipulator following closed hai 
trajectories are generally not closed in joint space trajectories. [3] proved that, without a modification, the generalized inver 
method need not even avoid kinematically singular configurations. Since the local optimization method only instantaneous 
minimize; a given criterion, it does not guarantee a global minimum and may even result in a disastrous manipulator mot* 

M. 

On the other hand, the global optimization technique ensures a solution with a global minim u m . Real-time coon 
based on global techniques is problematic, due to the heavy computational requirements. The global technique may be pt 
fectly adequate for co mm only encountered industrial problems requiring repetitive motion, since a specific solution will 
used over and over again. 

3.1 Local thiwmrif Resolution of Redundancy 

Moat local kinematic techniques resolve redundancy at the velocity level by using the pseudo-inverse J T (also known 
the Moore Penrose generalized inverse) of the Jacobian J: 

x = JO ‘ 

8 = J*;+(/-rj)<h ' 

j T = j T (j; T r l 

where 

i— 6 dim ensional velocity vector of the manipulator end 
6= n> 6 dimensional joint angle vector 

4>= arbitrary joint vector 

tti C projection of <j> into the null space of Jacob and corresponds to self-motion of the linkage that does « 
move the end effector. 

This approach is attractive in two ways. First, the pseudo* inverse has a least squares property that can minim ize exc 
sive joint velocities and make smoother motion. Second, the redundancy that is available is succinctly characterized by \ 
null-space of the Jacobian. Measures related to this formulation can be used to achieve some objective, ix., to avoid jo 
limi t*, singularities and obstacles [5,6,7]. A weighted pseudo-inverse (different from the null-space vector) can be used 
angers high and low priority of variables [8]. 

The Moore-Pcnrosc generalized invoice is problematic, however, in that it is noncooservative [2]. Repetitive mctit 
planned with the pseudo-inverse alone need not follow a repetitive path in joint-space. 

3 J 1 Global Kinemati c Resolution of Redundancy 

Nakamura [11] presented a method based on Pontryagin's Maximum Principle for globally optimizing a given cost fu 
tion for problems involving both kinematics and dynamics. An integral performance index of the following type is minimi: 
over a desired trajectory: 

f l p( e,r) dt 

where t, and t f arc the initial and final time respectively. For example, p -0 T 8+*w , where k is a constant and w is the a u 
pulatability index, was used by [11]. Pontryagin's Maximum Principle is then appUed to Equation 4 and Equation 2 wind 
treated as an ordinary optimal control problem of a dynamic system with 9 as an input vector. The Hamiltonian according 
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a fused time problem with a fixed time problem with a fixed left hand end-point and a free right hand endpoint if given by 

«(*. 9. + !k T i <9 

where ± is an auxiliary variable vector. The global solution if then given by choosing a £ that maximizes the Hamiltonian at 
every instant and solving the following 2n differential equations: 


b_ 

a* J 


T 


(<0 



(7) 


where Equation 6 is the same as Equation 2. 


33 Global Kinetic Resolution of Redundancy 

For problems including dynamics, a state vector v =[§ T 0 T f T was introduced in [llj. Using the inverse kinematics at the 
acceleration level, the kinematics equations are rewritten in the following form: 


v = Q( v,t ) + R(y )£ 


?(>!) = 



Joint torques can now be written in terms of v, <J>, and t as 
l(v,i > t)=y(v,t) + V(v)i 

u,(w,t) = Hit(i(t) - je) + e. c. e + g 

V(v) = H(I-JtJ) 

An integral performance index of the following type is then minimized: 


( 8 ) 

(9) 

( 10 ) 

(ID 

( 12 ) 

(13) 


+ (1 4 ) 

where k is a non-negative scalar. For example, setting k to 0 minimizes the joint torques in a least squares sense. The optimi- 
zation problem can be solved through Pontryagin's Maximum Principle. The solution requires solving 4n differential equa- 
tions. The algorithms used in Nakamura's dynamic method and the global algorithm presented in this paper are theoretically 
equivalent, but different methods are used in the formulation. 


4.0 Kinematic Programming Techniques 


4.1 Pseudo- Inverse Techniques for Redundancy Resolution 

The practical problem associated with planning joint-space motions for kinematically redundant manipulators is that of 
producing an arbitrary prescribed end-effector movement. To do so, the controller must choose among infinitely many 
corresponding joint space movements. 

For any robot, each possible joint angle configuration defines a unique position of the end effector of the robot arm. 
This is expressed mathematically by an equation of the form f(0) “ x , where x is a vector (typically six dimensional) defining 
the position and orientation of the end effector, and 0 is a vector defining the joint angle configuration. By differentiating 
both sides of the equation we obtain the kinematic relation 

= («<t)) 8(1) (15) 

from which we can compute 0(t) in terms of the prescribed end effector trajectory x(t). One way to uniquely specify a joint 
velocity vector for each i(t) is to use the Moorc-Pcnrose inverse given by 
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(16) 


= fwwm 


The joint velocities are minimized by this technique. But since joint velocities can become arbitrarily large near singular 
configurations [13], this technique appears to show promise for generating joint angle trajectories that automatically avoid 
singular configurations. However, analysis shows the Moore-Penrose inverse technique, without further restrictions, may gen- 
erate trajectories which pass arbitrarily close to singular points in joint angle space. Thus singularities are not avoided in any 
practical sense. This result is in contrast to some claims that have been made in literature [2]. 

Modifications to the Moore-Penrose pseudo-inverse technique can be made to avoid singularities. An alternative to 
Equation 16 for defining joint angle trajectories uses a projection operator onto the null space: 




‘-£ (°r £(o)l 

Ox* oo 


( 17 ) 


v is a (time varying) vector of the same dimension as a which remains to be specified. This modification of the Moore- 
Penrose pseudo-inverse technique can generate trajectories which avoid singular configurations by appropriate choice of v(.) 
in Equation (6). 


4.1.1 Functional Constraints for Redundancy Resolution 

A second class of methods for resolving redundancy, quite distinct from the generalized inverse methods, is that of 
imposing differentiable (for smooth motion) functional constraint relationships on the joint angles: 

<M8i. °2. e *) 55 0 


^(e t . 0*) = o W 

In general, however, it might not be possible to choose $ so that (0 lt 8j, 9j) satisfy the redundancy condition 
<K9 lt Qj) = 0 and depend continuously on the coordinates (x, y) of the end effector (a 2-d example of the method using a 
3-bar resolute joint, linkage in the plane). It is possible to find if some arbitrarily small area A of the workspace is excluded 
from the conditions, hence resolving the redundancy in a continuous way. 

4.1 J Obstacle Avoidance 

An optimality criterion defined in terms of a distance function will depend on how obstacles are represented. A simple 
way of representing manipulator link* is to model them as live segments between adjacent joint coordinate systems. Obstruc- 
tions in the workspace (modeled as, ej., primitives) can then be classified according to how and which links in the mechan- 
ism can be impeded. Analysis of various geometries will then indicate the cases in which the relative dimensions of the links 
represent undesirable designs. 

There are two major issues in incorporating considerations of obstacle avoidance into the design of kinematically 
redundant manipulators. First, the basic geometry of the mechanism must be specified. Then, dimensions of the manipulator 
must be chosen to maximize some measure of its capacity to function in a congested workspace. 

Each basic m ani pulator geometry will require specification of a figurc-of -merit. One example of such a figure of merit 
could be the distance a manipulator could reach behind an obstacle in the workspace, or the area excluded from the 
workspace because of the obstacle. These figures can be based on manipulator characteristics, workspace and obstacle dimen- 
sions, or, if this is not known at the design stage, probabilistic models or parametric analyses. 

4 2 Global Optimization Techniques 

Our research developed practical numerical methods for resolving redundancy and solving the inverse kinematics prob- 
lem, by minimizing a global (path integral) velocity criterion. These techniques are of interest because of the form in which 
the solutions are expres s ed is similar to that of the pseudo-inverse or Extended Jacobian techniques. This can be contrasted 
with other numerical techniques in which a repetitive and computationally costly process is used until the solution converges. 
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a solution is assumed, the problem is linearized, the linear optimal solution is found by a backward and forward 

sweep, and the linear optimal solution is used to update the nominal solution. 

Our method differs from these other numerical techniques: 

(1) No approximations or linearizations are required; 

(2) The solution is always in the form of a differential equation whoK solution is always a feasible joint space trajectory; 

(3) The 'optimal* solution is found by searching over a relatively small number of parameters comprising the initial condi- 
tions of the differential equation; and 

(4) The computational requirements of the solution for a particular set of initial conditions are comparable to those of the 
pseudo-inverse or Extended Jacobian techniques. 

Our approach is to view this problem as a boundary value problem (the theoretical basis for this approach is due to 
Nakamura [11]. We choose to use the additional freedom to minimize an integral of the joint velocities over the path: 

Minimize^ |9(t)p dt (W> 

subject to the constraint 

*(t)=/(9(l))- < 19 *> 

The constraint expresses the requirement the end effector follow a prescribed path in space. It is also possible to express the 
constraints in terms of velocities: 

*(!) = ■Jj’W ■ j*w (20) 

Solutions to the problem Equation 19 are obtained from use of undetermined Lagrange multipliers and the Euler- 
La grange equations, and Equation 19 becomes 

Minimize 0 ** L ( 6,0, X)~, X (21) 

with 

( 22 ) 

This leads to 

J T X - 8 = 0 (23a) 

and 

/ (9) - x = 0 (23b) 

For a kinematically redundant manipulator, the dimensions of J as such Equation 23 overdetcrmincs X in terms of 6. A 
direct consequence of this is the relation 

1,70=0 (24) 

where is any nullspace vector of J(U. t Jn } = 0, njn } * 0). Equation 24 is the necessary condition that was sought for joint 
space trajectories that extremize the integral of Equation (18). A solution for X that is consistent with Equation 24 is 
X = (JJ 1 )" 1 ! 0. When wc substitute this solution back into Equation 20, we have 

(J T (JJ 7r 'j -1)6 =0 (25) 

or, equivalently, -Pj0 = 0 where P, is the nullspace projection operator for J. Equations 24 and 25 are equivalent when 
(JiV exists. 

Equation 24 provides a second order differential equation that requires two boundary conditions to provide a particular 
solution. 

Analysts of this case where <K°) and 0(t) can vary, but are subject to kinematic constraint* at the endpoints, leads to 
the consequence 


3L _ _d_f aL| a() 3L 
36 dt ae 0X 
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»j(6(0)) t 8(0) - 0 

Oj(0(T) t 6(T) > 0 M 

This is the simple sutement that, when the only boondaiy condition on « is the kinematic relationship, / («) = *.<■** 
a necessary conditio (or the cost to be at an extremum is the component <* initial and final velocity in the nullspace of J he 


4.2.1 Differential Equations Dcacribftaf Optical Solutions 

The equations ot constraint . together with the remits <* the Eukr-Ugrange equations par presented, can be laed to 
derive differential equation, (or propagating the optima «(«). Such ^utiom mnn tiaaultuieoutiy Equation « i t»dtke 
kinematic constraint. / (e) = x. We have evaluated three ways to obtain differential equations i for • that tornt these cona- 
tions. They differ in the implied computational requirements and some o< the techniques introduce removable nngulantiei 
to the computation ot the solution. When singular behavior is not evident, all ot the techniques provide the same solution to 
equivalent boundary value problems. Finally, it should be empharized them differential equation, are necesmry but not suffi- 
cient (or an optimal value of <r in Equation 18. 

4.2.2 Direct Solution 

The moat direct way to obtain a second order differential equation meeting the criteria listed above is to differentiate 
the constraint equations twice with respect to time, to obtain 

.. . (27) 

x « J6 + J War, v 

When the pseudo-inverse solution for 0 in terms of x and 0 is examined, 

O = ^ 

where Jt - can one observe that this solution to Equation (27) also satisfies Equation (24), since *, T Jt = 0. This 

means a joint space trajectory integrated from Equation (28) and appropriate boundary conditions will meet the ncccawy 
condition for optimality. Note that, for this resolution to exist, (JJV must exist everywhere along the trajertory Thnvte 
equivalent to the requirement there be no kinematic singularities on the trajectory. This does not mean optimal ttajectona 
do not include singularities; it is possible to specify boundary conditions, for example, that are kinematically singular. 
'Optimal* solutions for such problems exist, but they are not a consequence of Equation (24) or (27). 

4 23 Reduced Order Solutions 

In order to obtain solutions to Equation (28) one must integrate a second order differential equation in a number of 
variables equal to the dimension of the joint angle vector. In principle, not all of these quantities need to be integrated sa 
some of them are already determined by the restraint of the kinematic relationship. There are two approaches thai die 
advantage of this situation. The first approach introduce! a parameter used to resolve the rcdundancy cxpbatiy Thc secaid 
approach uses the nullspace velocity as its parameter. In the tatter case, the parameter is not obviously related to the «*fi- 
guration of the manipulator at a particular time, but offers the advantage of introducing no removable or extraneous singu- 
larities in the differential equation. In the manipulators examined so far, the number of redundant degrees of freedom is 
one, but all methods presented can be extended to the case of multiple degrees if freedom. 

Both techniques can be derived in precisely the same way, and differ only in the particular functional relationship used 
to resolve the redundancy. 

4 2 J.l The Redaction Resolution Technique 

In the redundancy resolution (RR) technique, a redundancy resolution parameter, <j> = /(0), is introduced to resolve 
the ambiguity remaining after the constraint / (0) = x is met. 

Specifying both x and should provide enough information to compute 0. A velocity relationship can be obtained by 
differentiation: 

4> = a— 90 = m T 0 ^ 

a 
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In the null space velocity approach, the additional equation is defined directly in terms of the nullspece velocity com- 
ponent, 

Wi (30) 

These two equation* have the same form, and the analysis of each is similar, with substitution of appropriate parameters as 
required. 

Applying kinematic constraint, on joint velocity, and solving the renting set ol equatioM. we obuin a second-order 
differentialequation in a .eatar parameter that reptraent. either ♦ or a. The inverse o» Emended £»b«n rao “ 

explicit relationship for 8 in term, of i mid this strata parameter so th« the two toge^r provnlethe reduced order U . » 
Jtetoenaooof^ and „1 the dimension of x, the two relationships comprise a+2 coupled, firm order nooUnesr dtfferenttal 
that must be integrated. This can be eompmed with Equation (28). which n equivalent to 2«. thffercnttm cqua- 

tioos. . 

The principle advantage of the RR approach is that + is simply related to the configuration of the manipulator, and 
can be found directly. The principle disadvantage of the RR ipproach is that many •optimiT trajectories, depending on the 
particular conditions or boundary values, encounter singularities under certain conditions of the parameten. The Emendnl 
teobian technique remove, this angularity algebraically and there », then, the pomibility further work with the RR tech- 
oique can eliminate this disadvantage. 

4 232 The NnUspnce Velocity (NV) Tachnlqoe 

The alternative technique to the RR technique juat described t. the rewilutioo of the redundancy by a velocity con- 
straint. in particular, the specification of the velocity component in null space. An advantage to this approach is the lack of 
the 'removibte' singular points roasted with the RR technique. The NV technique use. the same bnc information used 
in the RR technique, rather than * and The computational com of integrating a particular solution from specified initial 
conditions using the NV formulation require, an amount of computation that is at learn comparable to the jneudo-inverse 
and Extended Jacobian techniques. 

The disadvantage of the NV technique, relative to the RR technique, is the parameter a has Uttle to do with the confi- 
guration of the manipulator at any given time. Its first derivative, d. is related to the nullspace velocity. Implication, one 
might assume a is related to the nuilspacc velocity. By implication, one might assume a is related to some distance traveled 
in the nullspacc direction, but this is a path dependent integral, so a need not necessarily take on the same value for the 
same manipulator configuration if the trajectories arc not identical. One available option is to integrate a subsidiary Ration, 
such as * = m T 0, rather then integrating d to obtain a, since a is not required in the formulation. This would provide a his- 
tory of the self-motion of the manipulator over the trajectory. 

43 Boundary Vata* Problems 

With the computationally efficient methods for obtaining solutions to Problem (15) in hand, the next issue is that of 
obtaining particular solutions associated with given initial conditions or boundary values. The sections that follow will pose 
each type of boundary problem in turn, and provide a numerical method for obtaining solutions to the problem. 

4 J.l Initial Boundary Vain* P roble m (IB VP) 

The initial boundary value problem is the simplest problem. The initial orientation and velocity of the manipulator is 
specified by the user, subject to the kinematic constraints. It is useful to specify the initial joint angles with a redundancy 
resolution parameter or parameters to avoid imposing a requirement on the user to specify a full joint angle set consisten 
with the kinematic restraint. This allows the user to specify the workspace position and manipu lator orie ntation m its self- 
motion at that position independently, rather than forcing the user to compute a joint angle set corresponding to the desired 
configuration. The initial position, then, is specified by the kinematic constraint in conjunction with a user-specified initial 

value of 0. 

The 'optimalitV' of the solutions generated by all the initial value techniques presented must be verified^ This is a 
direct consequence of the fact the Euler-Lagrange equations from which they are derived are only accessary J but i nsuffi- 
cient conditions for optimality. A solution generated from an arbitrary set of initial conditions may well be a locally max- 
imum cost solution, or may correspond to a solution that is first order stationary, but for which large changes in trajectory 

produce lower cost solutions. 
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4JJ Natural Bandar y Vafaa PraMn 

The •natural - boundary value problem occurs when there are ementialty no cooditioos on the configuration of the 
,| either endpoint, and we wish to find initial and final configurations that yield the least-cosi solution. A neces- 
sary con dit ion for the solution to the natural boundary value problem is the nullspace joint velocity be zero at the initial and 
final configurations. 

The approach developed to solve this boundary value problem uses the solution to the IBVP. The NVBP solution, then, 
can be reduced to finding the zeros of a function that is computed by solving the IBVP. This approach provides solutions that 
satisfy the Decenary conditions for optimum solutions to the NBVP, but to find the actual optimum all solutions must be 
examined. 

The computational requirements imposed by the requirement to examine the entire range of solutions to the IBVP is 
obvious. The worst case computation cost of the solution can be immense. Rather th a n integrating the NV equations once, as 
was required for the IBVP, the NBVP requires, in principle, infinitely many such evaluations. However, many practical 
motion profiles give rise to a relatively smooth function for the nullspace velocity component a , and the zeros of this func- 
tion can be isolated with a small number of evaluations of the IBVP. 

A final aspect of this solution technique is poor performance, as might be expected, when the initial (or final) confi- 
guration is itself near a kinematic singular point. 

4JJ Two Poftat Boundary Vatee Problem (TPBVF) 

Solutions to the two point boundary value problem can be obtained by a method analogous to that used for the NBVP. 
In this problem, <kg and or equivalent information is given. The solution to Equation (19) is required and can be found by 
m.n«i C use of the IBVP solution. The TPBVP approach take* ^ as the configuration initial condition snd searches for a 
velocity initial condition, ^ leading to a solution with ^ as the final value of +. 

In general, it is likely that will completely resolve the redundancy. Specification of additional parameters should 
allow to be known unambiguously. 

4J.4 Periodic Bousdary Value Problem (PVBP) 

This is the problem of finding the least cost periodic motion for 9(r) corresponding to a workspace motion z(r) that is 
also periodic, or cyclic. That ii, we have a situation where *(0)=x(T), wc to find 9(f) that is a solution to the prob- 
lem of Equation (1), and meets the additional constraints 9(0)=fl(T) and 9(0) -«(T). This results in a joint angle time history 
that follows the desired trajectory, is periodic, and is low cost in the sense of Equation 19. 

This problem differs from the previous boundary problems as it requires a search in two variables, ^ and a* for the 
simultaneous zero* of two expressions that specify the problem. Intersections of plots of jdutions to these expressions will 
correspond to solutions, but spurious solutions will have to be rejected. 

4.4 Summary 

This section has presented a new technique for generating globally optimal solutions (in a velocity-magnitude squared 
sense) to the inverse kinematics of redundant manipulators, due to Nakamura. The section discussed the computational 
requirements of the techniques and showed derivations of two reduced order methods. It presented solutions related four 
different types of boundary problems. The techniques presented are a practical off-line means of finding good solutions to 
the inverse kinematics of redundant manipulators. 

5.0 Dynamics and Control 

This section presents a local and a global optimization method for minimizing torque leading at the joints in the least- 
squares sense. The local optimization technique minimizes torque by specifying a null space vector using a generalized 
inverse applied to accelerations. The local method is compared to a straightforward pseudo-inverse and an inertial-weighted 
pseudo-inverse. The global optimization method is formulated through the use of calculus of variations, and is compared 
with the local algorithms. 
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5.1 Local Tarqwa OftkmkmAm 

RedttDdancy rcaotutiou uring local torque optimixatioa can reduce joist torque and raid joint torque tints throughout 
the manipulator movement. An effective approach is to keep the joint torque* clone to the midpoint of their upper and lower 
torque Units. Thk is dooe in a least squares sense by mfrihn i ring a vector that combines a vector of the upper limits erf the 
joint torques and the vector of lower limits. For simplicity, these Units are assumed motion independent. The kkt of dif- 
ferent available torque ranges la easily solved by using a weighting matrix with proper representation of the available torque 
ranges. 

The algorithms we investigated are: 

• Unweighted pseudo-inverse algorithm (UPI) 

t - Hjt<* - i?) + £ + 5 < 31 ) 


• Inertia-weighted pseudo-inverse algorithm (IWPI) 

t -H j£ (i -je) + C +| 

• Unweighted null-space algorithm (UNS) 

/ .A ft* + l] 

t ■ HJt[i - Jtj + C + | + H { H(I - JtJ) ] t 3 — ^ — *• 

• Weighted null-spece algorithm (WNS) 

t-Hjt<«-ja) + c+g + H[w^(i-jn)]twV+r| 


(32) 

(33) 

(34) 


The unweighted pseudo-inverse algorithm derives the joint torques without the null space component yielding a solu- 
tion with minim um e T 0. Presumably, this should keep joints from moving too fast if started at rest, posribiy yielding a more 
controllable motion. The inertia weighted pseudo-inverse algorithm [9, 10] yields a mi n imu m kinetic energy solution. The 
unweighted and weighted null-space algorithms are the proposed methods presented in the previous section. 


5J.1 Rsoalts 

Performances of the unweighted null-space (UNS), unweighted pseudo-inverse (UPI) and inertia- weighted pseudo- 
inverse (IWPI) algorithms were compared for representative trajectories and amumed characteristics of a basic three-link 
planar rotary manipulator. 

For a short movement, the UNS dramatically reduces the joint torques over the UPI, with the IWPI falling somewhere 
between the two. A dramatic reduction in joint torque of the UNS is the sum contribution to the overall increase in perfor- 
mance. For a medium length movement, the UNS still shows a dramatic reduction over "die USI, with the IWPI again falling 
in between. 

The situation changes considerably for a long movement. Both the UNS the IWPI algorithms show unexpected instabil- 
ity near the end of the movement. The instability seems to be caused by the alignment of the second and third links and the 
large joint velocities associated at the time of alignment. The redundancy of the arm is partially lost in the first joint at the 
alignment, and the targe joint velocities require extremely large joint torques to keep the manipulator on the desired trajec- 
tory. Evidently, the UNS and IWPI algorithms always show instability for relatively long trajectories. 

The UP! algorithm appears to be more stable. There were a few trajectories where only the WPI showed the instabil- 
ity. The UPI algorithm goes through a partial low of redundancy in the third joint near the movement midpoint, and another 
lam of redundancy in the second joint near the end of the movement. Theae lames of partial redundancy together with the 
targe joint velocities seemed to have caused the instability of the UPI algorithm. 

In the WNS for the same trajectories, the third joint torque is pulled much closer to its midpoint at the expense of the 
first and second joints. However, all the joint torques are well within their ranges. Unfortunately, the WNS also shows this 
instability in long movements. There were even movements where the instability is shown only by the WNS. The characteris- 
tics of the instability in the weighted case were identical to those of unweighted cases. 
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Lora l algorithms show dramatic improvement over the unweighted and pseudo-inverse algorithms in trajectories of 
short length. However, for long trajectories, the null-space algorithms and the IWPI algorithm all have stability problems. 

Only the UP1 algorithm was generally well-behaved, although it too showed instabilities. ! 

It seems local tampering with the energetics of movement leads to global disaster. The instability shown by the IWPI 
and the UNS and WNS seems to be caused by the line-up of links 2 and 3 together with high joint velocities at this confi- 
guration. Since the use of the null-space vector adds to the joint acceleration vector, the joint torques are minim ized at the 
cost of large joint velocities. These large joint velocities eventually caused the manipulator's second and third links to line up, 
resulting in a partial lorn of redundancy with the inability of joint l torque to vary. The UP! the instability less often. Since 
the UPI gives a solution of minimum joint accelerations in a least square sense, the joint velocities are restrained from caus- 
ing links 2 and 3 to line up. Nevertheless, the UPI can go through another type of manipulator configuration with partial loss 
of redundancy and eventually go unstable. 

5.2 Global Optimization 

The undesirable behavior of the local optimization techniques has led to development of a global method for optimizing 
joint torques. The method parameterizes the redundancy of a manipulator and uses the calculus of variations. This formula- 
tion requires explicit inverse kinematic solutions and extra time derivatives of the variables involved, as opposed to 
Nakamura's [11] use of Lagrange multipliers and Pontryagin'i Maximum Principle. However, only a single fourth-order ordi- 
nary differential equation needs to be solved, instead of 4n elementary differential equations required by Pontryagin'i Princi- 
ple for a manipulator with one degree of redundancy. The global optimization algorithm is formulated using a variable + that 
parameterizes the redundancy of the manipulator. The hand variables x with specifies a joint configuration. Therefore, 
given a desired trajectory x(t), the corresponding trajectory of the manipulator can be solved in terms of x(t) and <Kt). 

The objective of this technique is to place the joint torques closest to the midpoint of the joint torque movements over 
the entire movement. This is done in a least squares sense by m ini m izi n g an integral of joint torques over the entire trajec- 
tory. The performance index to be optimized is expressed as a function of and its first two derivatives and t over the time 
of movement. The problem is to find a that minimizes this performance index. This is a straight-forward problem in cal- 
culus of variations whose solution is given by an Eulcr-Lagrange equation with appropriate boundary conditions. 

The Eulcr-La grange equation can be expressed as fourth-order ordinary differential equation in and four boundary 
conditions are needed to solve for the optimal solution. Two of these are readily obtained from the initial manipulator confi- 
guration, namely <fr(0) and <K0). The remaining two conditions are given by the transversaiity condition at t » t*. The prob- 
lem then becomes a two point boundary problem which can be solved numerically. However, since there are only two unk- 
nown initial values, <j>{0) and d 3 -^t 3 (0), the space of these two unknown values can be searched for the optimal solution. 

d 

Various well-known initial value integration methods may then be used to search for the solution with the minimal perfor- 
mance index. 

52.1 Results 

As expected, the global solution erf the short movement closely resemble* the UNS algorithm. However, for trajectories 
where the UNS showed instability, global solutions more closely resemble the stable UPI solution. 

5 22 DbcussfcM 

The unacceptable performance of the local algorithm in minimizing actuator demands over the whole trajectory has led 
to the development of a global algorithm formulated through the parameterization of the redundancy and the method of cal- 
culus of variations. (Even though the global methods are computationally infeasible for real-time control, they could be used 
in repetitive motions commonly found in industry.) Results of the global algorithms are very promising; a solution was found 
that outperformed all the local algorithms in movements of all lengths, even those long movements where the local algorithm 
showed the instability. 

Whether the local kinematic methods may be modified to avoid the instabilities is not known. One possibility is to 
weight the local optimization criterion with a kinematic term to avoid high velocity buildup. For staying within torque 
bounds, linear programming, rather than least squares, may be more satisfactory. The broader question is whether any iocal 
algorithms can ever be completely successful, or whether ultimately only a global resolution of redundancy can be 
guaranteed problem-free. 
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More questions should be addreaed before these algorithms can actually be applied to the control of redundant mani- 
pulators. First, the joint angle, velocity and torque limits cannot be enforced with the algorithms formulated. The global 
algorithm may be formulated in terms of Pontryagain'a Maximum Principle to incorporate the joint torque linutr, however, 
thejoint angle and velocity limits still cannot be addressed. State-space search may have to be used for the enforcement of 
all manipulator constraints. Second, even though the manipulator starts are rest and ends at zero hand velocity, the resulting 
joint velocities may not be zero; that is, the manipulator continues to move at the end of the movement. The algorithms may 
continuously be applied at the movement end to keep the hand from moving; however, this does not g^tMihe arm will 
eventually come tore*. For any reasonable tasks, this is highly undesirable; therefore, the algorithms should be modified in 
some ways so the manipulator comes to a complete stop or a desired configuration at the movement end. 
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